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EULER ANGLES, QUATERNIONS, AND TRANSFORMATION MATRICES - 
WORKING RELATIONSHIPS 
By D. M. Henderson 

McDonnell Douglas Technical Services Co., Inc. 

1 .0 INTRODUCTION 

Due- to the extensive use of the quaternion in the onboard Space 
Shuttle Computer System, considerable analysis is being performed using 
relationships between the quaternion, the transformation matrix, 
and the Euler angles. This Internal Note offers a brief mathematical 
development of the relationships between the Euler angles and the 
transformation matrix, the quaternion and the transformation 
matrix, and the Euler angles and the quaternion. The analysis 
and equations presented here apply directly to current Space 
Shuttle problems. Appendix A presents the twelve three-axis 
Euler transformation matrices as functions of the Euler angles, 
the equations for the quaternion as a function of the Euler angles, 
and the Euler angles as a function of the transformation matrix 
elements. 

The equations of Appendix A are a valuable reference in Shuttle 
analysis work and this Internal Note is the only known document where 
each of the twelve Euler angle to quaternion relationships are 
given. Appendix B presents a group of utility subroutines to 
accomplish the Euler-matrlx, quaternion-matrix, and Euler- 
quaternion relationships of Appendix A. 


2.0 DISCUSSION 


2.1 Euler Angle Transformation Matrices 
The following analysis and utility subroutines are offered to simplify computer 
programs when working with coordinate transformation matrices and their relation 
ships with the Euler Angles and the Quaternions. The coordinate transformation 
matrices discussed here are defined using the following figure, 


-i 



Figure 1.- Coordinate system and Euler angles. 



The transformation matrix M, is defined to transform vectors 
in the x- system (7, y, 7) into the original x-system 1 y, 
z) and is given by the equation, 
x = tfx 

where (1) 

x 3 (x, y, z) and 7 = (7, y, z). 


Using the right-hand rule for positive rotations, the M matrix 
in (1) above is constructed by the following analysis. The 
first rotation in Figure 1 above is about the x-axis by the 
amount 0-j . The single rotation about the x-axis results in 
the following transformation, 



/’ 

0 

0 ^ 


iT\ 

0 

cose 1 

-sine^ 


y ' 

\° 

sine^ 

COS0-J j 


l F 7 


( 2 ) 


or x = Xx 1 in matrix form. Rotation about the y'-axis by the 
amount yields the intermediate transformation matrix: 



(3) 


or x 1 « Yx' in matrix form. Finally rotation about the z"-axis 
by the amount yields the intermediate transformation matrix. 


and In matrix form x" » Zx r Now using the three equations, 


x = Xx* 

x' « Yx" ^ 

x" ° Zx 

by substitution 

x s {X Y Z) x. 

Then from equation 1 , 

H * (X Y Z) 

Computation for the M matrix from the indicated matrix multi- 
plication In equation (7) yields, 

(cose 2 cose 3 ) {- cose 2 s1ne 3 ) (sln© 2 ) \ 

(cos6 1 sine 3 + sin8 1 s1ne 2 cose 3 )(cose 1 cose 3 - slnBj s1ne 2 s1n© 3 ) (- sine 1 cose 2 ) 1(8) 
k (sine 1 sine 3 - cose 1 s1ne 2 cos 9 3 )(s 1 ne 1 cose 3 + cos8 1 sine 2 sine 3 )(cos8 1 cose 2 ) / 

The matrix H In equation (8) is a function of; 

(1) The three Euler angles 8 1 fi 2 and 8 3 and 

(2) The sequence of rotations used to generate the matrix. 

By examination of equation (7) it Is possible to show that there 
are twelve possible Euler rotational sequences. If the (X Y Z) 
notation In equation (7) represents a rotation about the X axis, 
then the Y axis and finally the Z axis, then the following per- 
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mutations of the rotational order represents the twelve possible 
Euler angle sets using three rotations, 

XYZ YXZ ZXY 

XZY YZX ZYX 

(9) 

X Y X YXY ZXZ 

XZX YZY ZYZ 

Any repeated axis rotation such as XXY does not represent a 
three axis rotation but reduces to the two axis rotation XY. 
hence the rotations described in (9) above represent all 
twelve possible sets of Euler angle defining sequences. Con- 
versely then, for a given transformation matrix there are 
twelve Euler angle sets which can be extracted from the matrix. 

The Euler matrices corresponding to all possible rotational 
sequences of (9) above are presented in Appendix A. 

The utility subroutines "EULMAT" generates the transformation 
matrix from a given Euler sequence and the Euler angles. The 
utility subroutine "MATEUL" extracts the Euler angles from a given 
Euler rotational sequence. Th§ Convention Is established that 
the Euler angles occur in the same sequences as the axis 
rotations. Using this concept and functional notation, equation (7) 
could be expressed as 

M = X Y Z - M(0 x , 8y, 0 2 ) (10) 

and from (9) 
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M = X Z X * M(9 x , 0 z , 6*) etc. (11) 

This convention is assumed In both subroutines and also 
used throughout this design note when Euler angles are 
used. A brief explanation of the use- of these two 
utility subroutines is given in Appendix B. 

It is interesting to note that a negative rotation in 
the single axis rotation matrices of equations (2), (3) 
and (4) will result in the formation of the transpose 
of the matrix. However the transpose of M in equation 
(7) is formed from reversing the order of multiplication 
and transposing the individual axis rotation equations* 
i .e. 

M T = (X Y Z) T = { Y Z) T X T * Z T Y T X T . (12) 

Hence the transposes of the matrices of (9) are easily 
formed by reversing the order of multiplication and 
transposing each single axis rotation equation. Using 
the notation in equations (10) and (11) above equation 
(12) could be written, 

M T (8 x , 6 y » e z ) . MT-8 2 , -8 y , -8 X ). (13) 

It is recommended to avoid confusion that the forward 
transformation be computed and simply transposed to yield 
the reverse transformation matrix. All matrices of Appendix 
A are in the forward form, i.e. X = Mx arid formed from (9). 
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2.2 Transformation Matrices Using the Hamilton Quaternion 
The transformation matrix of equation (1) can be written as 
a function of the Hamilton Quaternion; 
q^ = cos w/2 

q 2 = cos a sin m/2 ^ 

q 3 = cos Bsin ui/2 
q 4 * cos y sin tu/2 , 

where u is the rotation angle about the rotation axis with 

a, B, and y direction angles with the x, y and z axes re- 

2 2 ' 2 2 

spectively. Notice also that q-| + q 2 + q 3 + q 4 s 1 » since 
cos 2 a + cos 2 £ + cos 2 y 55 1. The rotation angle, w, is assumed 
positive according to the right-hand rule of axis rotation. 

The matrix M becomes 

( (q* ♦ . q* - qjj) 2(q 2 q 3 - q,q 4 ) 2(qj,q 4 + q,q 3 ) \ 

* I 2(q 2 q 3 +q,q 4 ) (q* -q| + q 3 -qj) 2(q 3 q 4 - q,q 2 ) j (15) 

\ 2 2 2 2 / 

\ 2(q 2 q 4 - q 1 q 3 ) 2(q 3 q 4 + q^) (q ] - q 2 “ 0 3 + %) / * 

For a more detailed discussion of the derivation of equation 
(15), see Reference 1. Using functional notation, equation 
(15) can be written, 

M = M(q-| , q 2 , q 3 » q 4 ). ( 16 ) 

Unlike the Euler angle rotational sequences to describe the 
transformation matrix of equation (1), only two quaternions 
can be found from equation (15). The two quaternions afe: 



\ 


q 2 

^3 

^4 


-«1 

-<*2 

-q 4 . 


07 ) 


These two quaternions represent a positive rotation about 
the rotation axis pointing in one direction and a positive 
rotation about the same line of rotation pointing in the 
opposite direction. Both quaternions of (17) satisfy equation 
(15). 


The utility subroutine "QMAT" generates the transformation 
matrix from a given quaternion. The "QMAT" algorithm generates 
the matrix as given in equation (15) without duplicating any 
arithmetic operations. The subroutine "MATQ" extracts the positive 
quaternion, i.e., q^ > 0, from the transformation matrix and 
normalizes the results to guarantee an orthogonal matrix. In 
order to avoid any discontinuity In extracting the quaternion 
from the transformation matrix, the procedure as described in 
Reference 2 is used. 

Early works by Hamilton (Reference 3) presented the quaternion 
as having a scalar and a vector part, i.e., 

q-j “ S V = (q 2 , q 3 , q^) (18) 

and equation (16) could be expressed as, 

M - M(q r q 2 , q 3# q^) » M(S, V). (19) 
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For a given quaternion the following relationship Is 
true (from (17) above), 

M(S, V) = M(-S, -V). (20) 

The transpose of the transformation matrix is given by, 

M T (S, V) = M(-S, V) = M(S, -V). (21) 

2.3 Euler Angle and Quaternion Relationships 

B,y examination of equations (10) and (16) the equality, 

M(X(8 1 ), Y(0 2 ), Z(0 3 )) 3 M(9 r 0 2 , 0 3 ) 3 M (q r q 2> q 3 , q 4 ) (22) 

can be written. Based on an equality for each element of the 

matrix the following nine equations must be true; 

2 2 2 2 

cos0 2 cos0 3 = q^ + q 2 - q 3 -■ q 4 

-cos0 2 sin© 3 = 2(q 2 q 3 - q ] q 4 ) 

Sin0 2 = 2(q 2 q 4 + q ] q 3 ) 

cos0-| s1n0 3 + sin0.| sin0 2 cos© 3 = 2(q 2 q 3 + q 3 q 4 ) 

2 2 2 2 (23) 

cos6-| cos0 3 - sin0^ sin0 2 sin0 3 3 q-j - q 2 + q 3 - q 4 

-Sin0 1 cos0 2 = 2(q 3 q 4 - q ] q 2 ) 

sine^ sin0 3 - cosO-j sin0 2 cos0 3 3 2(q 3 q 4 - qi q 3 ) 

sin0 1 cos0 3 + cos0-j sin0 2 sin© 3 3 2(q 3 q 4 + q-|q 2 ) 

2 2 2 2 

cos0-| cos0 2 = *q-| ** ^2 ” q 3 + * 

It is possible to solve for the values of the quaternion using 
the trigonometric half angle identities. For this Euler sequence, 
i.e. X( 0 -|) Y (0 2 ) 1 (e 3 ), the following quaternion results; 
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q-, = -sin' a e 1 sin^0 2 sin^0 3 + cos^O-, cos^0 2 cos*^ 

q 2 = +s1n'j,0i cos-^0 2 co$ 40 3 + sin^g sin^0 3 cos%0j 

(24) 

q 3 =■ -sin^e-j sin‘^ 0 3 cos 1 ^ + sin^ 0 2 cos^o-j cos%0 3 

= +sin^e-| sin^0 2 cosJse 3 + sln^Qj cos^0^ cosJj0 2 

Appendix A gives the quaternion as a function of the Euler 
angles for each of the twelve Euler rotational sequence pre- 
sented in Section 2.1. The special equations for the quaternion 
as functions of the Euler angles, like equations (24) above, 
are sometimes cumbersome to use, especially when multiple 
Euler sequences are utilized. Less coding, but perhaps more 
computer operations, are required by using the more general 
method of first generating the matrix M from the given Euler 
angle set and then simply extracting the quaternion from the 
matrix. This method is effected by first a call to "EULMAT" 


and then a call to "MATQ“. 
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APPENDIX A 

RELATIONSHIPS FOR THE THREE-AXIS EULER ANGLE ROTATION SEQUENCES 

The twelve Euler matrices for each rotation sequent are given based 
on the single axis rotation equations (2), (3) and (4). The Euler 
matrices transform vectors from. the system that has been rotated Into 
vectors In the stationary system. - Also presented here are the equations 
for. the .quaternion as a function of the Eu1er_angles and the Euler 
annles as a function of the matrix elements for each rotation sequence. 



q^ = -sin^e-iSin^egSin^Oj + cos>50.jCosJ50 2 cos*50 3 

q 2 = sinJ 5 0 1 cosH0 2 cos%0 3 + sin^sin^cos^ 

q 3 = -sin^e^sin^e-jcos^ + sin*50 2 cosJ50.|COS%0 3 

q 4 = sin^sin^cosJsG.j + sin^cos^cos*^. 
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■-V 


f 


i 
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M - M(X(0 1 ), Z(0 2 ), Y(0 3 }) 

= XZY 


Axis Rotation Sequence: 1 

, 3, 2 



COS0 2 COS0 3 

-sin0^ 

£-- ■< 

cos0 2 sin8 3 

M = 

cos0 1 sin0 2 cos6 3 

+$100^1002 

COS0.|COS0 2 

cosO^inegSine 

-sino^cosOg 


sino^iftOgCOSSj 

-cos0.|Sin8 3 

sin0^cos0 2 

s1n0^sin0 2 stne. 

+COS0^COS0 3 


q-l ■ +sin>50 1 s1n^0 2 sinJ5Q 3 + cos^cos^cosJ^ 
q ? = +sinJa0 1 cos%0 2 cosJs8 3 - sin^sin^cos^ 
q 3 = -sin^e 1 sin%0 2 cos^0 3 + sin^cos^cos^ 
q 4 = +>in%0-jSin%0 3 cos^0 2 + sin^cQS^S-jCos^ 





Axis Rotation Sequence: 1 , 2 , 1 



M 


cos0 2 s1ne 2 s1ne 3 

sine^sinog cosQ-jCosOj 

-sin 0 -|COS 0 2 s 1 n 03 

-cose^sin 0 2 +s1n9.|Cos03 

+ cos0|COS0 2 sin0 3 


s1n0 2 cos0 3 

-cos0 1 s1ne 3 

-sin 0 -|COS 0 2 cos 03 

-sina^sInOg 

+COS 0 iCOS 0 2 COS 03 


q-j * cos^coste^ + $3)) 
q 2 * cos^sinOs^ + ©3)) 
q 3 = sin i s0 2 cos( } s(0^ - 83)) 
q 4 =* slnVPgSlnftte^ - 83}) 
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(4) M - M(X(0 ] ), Z(0 2 ), X(0 3 )) = XZX 

Axis Rotation Sequence: 1, 3, 1 


sinOgCOsO^ 
COS0-|COS0 2 COS0 3 

-sin0- l sin0 3 

sin0^cos0 2 cos0 3 
+COS0-|Sln0 3 

= cosSs0 2 cos(^(0i + ^3) ) 
q 2 = cos^0 2 sin(%(0-j + 63)) 
q 3 = -sin%0 2 sin(^(0 1 - 83)) 
q. - sinJ50 9 cos(^(0-, ~0-i )) 


M = 


cos0 2 

cose^sine 2 


sin0^sin© 2 


sin0 2 sin0 3 

-cos0^cos0 2 sin0 

-sin0 1 cos0 3 

-sin0^cos0 2 sin0 

+COS0-|COS0 3 




(5) M = M(Y(8 1 ) , X(0 2 ), Z(0 3 )) - YXZ 
Axis Rotation Sequence: 2, 1, 3 




= sin'sO^sin^sin^ +■ cos^O^cos^cos^ej 
q 2 = sin?50 1 sin^8 3 cosJ50 2 + sin^cos^cos^ 
q 3 = sin^0|Cos)50 2 cos)50 3 - sin^si'n^cos^ 

q 4 = -sin?50^ sin^cos^ + sin^cos^cos^ 







(6) M - H(Y(e 1 ), Z(e 2 ). X(0 3 )) - YZX 


Axis Rotation Sequence: 2, 3, 1 


cose.]Cose 2 


M = 


sin8 2 

$106^00502 


-cose-|Sin0 2 cos0 3 

+sine-|Sin0 3 

cos0 2 cos0 3 

sinO^sin02COS0 3 

+cos0^sine 3 


cos0-|Sin0 2 sin0 3 

+sin0.jcos0 3 

-cos0 2 sin0 3 

-sin0^sine 2 sin0 3 

+COS0-jCOS0 3 


q 1 = -sin%O 1 sin^ 0 2 sin* 28 3 + cos5*e.|COsJse 2 cos5s0 3 

q 2 * +sin550 1 sin55e 2 cos520 3 + sin^cos'sO-iCOS^ 

q 3 = +sin550-|Cos520 2 cos550 3 + sinM^sinJ^cosSfO-i 

q^ = -sin5s0isin550 3 cos520 2 + si n^OgCos^O-j 005*58 3 
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(7) M = X(0 2 ), Y(0 3 ) ) = YXY 

Axis Rotation Sequence; 2, 1, 2 


M = 


-sine^cose^sinOj 

+COS 0 -jCOS 0 3 

sinO 2 sin0 3 

-cos0^cose 2 sine 3 

-sin0-|COS0 3 


sin0-|Sin0 2 

cos0 2 

cos0^sin0 2 


= +cos40 2 cos(Si(0-| + 0 3 )) 
q 2 ■ +sin^0 2 cos(J5(0 1 - 0 3 )) 
q 3 = +cos^0 2 sin(is(0 1 + 0 3 >) 
q 4 = -sin 1 ^0 2 sin(^(0 1 - 0 3 )) 
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sin0.jcos0 2 cos0, 

+cos8-jsin0 3 

-sin0 2 cos8 3 

cos0.|cos0 2 cos0 

-sinO^inG^j 


(8) M = MtY^), Z{0 2 ), Y(e 3 )) = YZY 
Axis Rotation Sequence: 2, 3, 2 


M * 


COS6-|COS0 2 COS0 3 

-sin0-|Sin0 3 

sine 2 cos0 3 

-siriO^cosO^ose^ 

-cos0-|Sin0 3 


-cos0-jSin0 2 cos0-jcos0 2 sin0 3 

+sin0^cos0 3 

cos0 2 sin0 2 sin0 3 

sin0-|Sin0 2 -$in0^cos0 2 sin0 3 

+COS0-|COS0 3 


= +cos^8 2 cos(%(0 1 + 63)) 
q 2 = +sin 1 a0 2 sin(^{0 1 - 83)) 
q 3 = +cos^0 2 sin(^{8i + 83)) 
q^ = ^sin^gCOst^O^ - 83 )) 



(9) M = M(Z(0 1 ), X(e 2 ), Y(0 3 )) = ZXY 
Axis Rotation Sequence: 3, 1, 2 


r 

[ 


-sine 1 sin0 2 sin0 3 

+COS0-J COS0J 

M _ cos0-|Sin0 2 sin0 3 
+sin0-|Cose 3 

-cos0 2 $in0 3 

q 1 = -sin%0 1 sin*s0 2 sinJ50 3 + cos^cosnegcos^ 
q 2 = -si n^ 0 i si n% 0 3 cosH 02 + sin^cos^e-jcos^ 
q 3 = +sini*0 1 sinJs0 2 cos%0 3 + sin%0 3 cos^0-|COs^0 2 
q^ = +sin5s0 1 cos%6 2 cos^0 3 + sinH0 2 sin5s0 3 cos^0-| 
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-sin0^cos0 2 s1n0-|Sin0 2 cos0 3 

+COS0-|Sin8 3 

cose^coseg -cos0 1 sine 2 cos0 3 

+sine-|Sin0 3 


sine. 


cose 2 cos0 3 


(10) M - M(Z(0 t ), V(e 2 ), *(83)) - zvx 

Axis Rotation Sequence: 3, 2 , 1 

cos0.|Sin02Sin02 cosO^sinOgCOsO 

-sine.|Cos0g +sin0-jSln0 3 

si ne^ si n0 2 si n0 3 s i ne-j si n0 2 coso 

+0050^0303 -COS0-J sin0 3 

cos0 2 $in0 3 cos 0 2 cos 0 3 

q 1 = +sinJg0^sinJs0 2 sin3s0 3 + cos^cos^cos^ 
q 2 = - s i n%0 1 s i n-^02 c 0 s ‘^9 3 + si 0^03005^01005^02 
q 3 = +sin 1 i0 1 sin^0 3 cos^0 2 + sin^cos^cos^ 
q 4 = +s i n%0 •, co s ?i0 ? co s ^0 ^ - sin^sin^-cos^o. 



(11) M = k(0 2 ), Z(0 3 )) - ZXZ 

Axis Rotation Sequence: 3, 1, 3 


-sin0iCOS02sin0 3 

+COS0-|COS0 3 

cos0^cos02Sin0 3 

+sin0-jcos0 3 

sin0 2 sin0 3 


-sin0-|Cos02Cos0 3 

-COS0-|COS0 3 

COS0-jCOS0 2 COS0 3 

-sin0-|Sin0 3 

s1n0 2 cos0 3 


sin0,s1n0 

I 

-cos0-jsin0 

cos0 2 


= +cos*50 2 cos(*5(e-, + 63 )) 
q 2 = +s1n^0 2 cos (%(©-, - 83)) 
= +sin^02 s ^ n (^(®i " 

q. = +cos%02sin(J5(0 1 + 83)) 





( 
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'12) M - M(Z(0 1 ), Y(0 2 ), Z(6 3 )) = ZYZ 
Axis Rotation Sequence: 3, 2 , 3 


M = 


COS0.|COS0 2 COS0 3 

-sin0 1 $in0 3 

-cos0-| cos0 2 s1n8 3 
-sin0-|COs0 3 

cosO^inOg 

$100^050200502 

+0050^5^02 

-sin6^cos0 2 sin0 3 

+COS0-J COS0 3 

Sln0.|Sln0 2 

sine 2 cos0 3 

sin0 2 sin0 3 

cos0 2 


q 1 = +cosH0 2 cos(Js(0-| + 0 3 )) 
q 2 - -sin^0 2 sin(J5(0-| - 0 3 )) 
q 3 = +sinJ 50 2 cos(%( 0 -, ~ 0 3 )} 
q 4 = +cos’20 2 sin(%(0 1 + 6 3 )) 






APPENDIX B 

COMPUTER SUBROUTINES FOR THE RELATIONSHIPS 

The following subroutines with a brief description of their use are 
presented in this appendix. 

(1) "EULMAT" - Generates the transformation matrix from a given set of 

Euler angles and an axis rotation sequence. 

(2) "MATEUL" - Extracts the Euler angles from the given transformation 

matrix and an axis rotation sequence. 

(3) "QMAT" - Generates the transformation matrix from a given 

quaternion. 

(4) "MATQ" - Extracts the quaternion from a given transformation 

matrix. 

(5) "YPRQ" - Generates the quaternion directly from the yaw-pitch- 

roll Euler angles. 

(6) "POSNOR" - Computes the positive-normalized quaternion from the 

given quaternion. 



NAME: 


PURPOSE : 

INPUT : 

OUTPUT : 

ALGORITHM 


EULMAT 

Generates a 3 x 3 transformation matrix from a 
given sequence and Euler angle set. 

ISEQ - Rotation. Sequence (Integer Array (3); i. 
V.2, 3) 

EUL -.Euler Angles in radians, in "ISEQ" 

Order*, ARRAY- (3) 

A - Tile 3 x 3 transformation matrix 
REFERENCE : Appendix A; Euler Sequences (1) thru (12). 


EULER ANGLES TO THE TRANSFORMATION MATRIX 


AfOR.IS rULHM*EuLH*T 
f Oft SDE3 -Cc/ift /7 7-062243 21 1*01 

SUBROUTING LUL^At TN1R V. ftOlNE-P "u.2l7 

STORAGE USfl>; C0D£«1> uDCZSO; DATA (0 1 Mi2ki *LkhK CaHHON^I 

EXTERNAL. REF£FENC rS (BLO C K » N*pE> 

r.~s tin 

-,-.-4 COS 

•; * .*j5 

STORAGE ASSIGNMENT IdLOCK, Tf OF, RELATIVE LOCATION, NAHEl 


r>wi 

- :ul 


142 
: ^ - J 7 


lCGl 

1620 

iSS-i 


??GG ft -?C?r4T SIN A 


4 :i az !?t»c 

, -.,1 :r 'i44 i6so 

; p jd v-*i r 
■ - ^ I jn '.ittb j 
COOT P an^ra5 3 TCHF 


:odi z-rzii 

■:ri 'mt 

w . : ~ >- i ^ - 

1 

jrcarr p -3TBK 


.uici 

-C1C 4 
-Clf * 
,'uiu 3 

jail? 
GO 11 3 
-.0116 
:ci 1 7 
;Ul?i 
‘.012 3 

J0l?7 
20130 
3^131 
>:u3 
.r 13.*. 
.: i3'j 
.013 7 

jSfti 

,0142 
.tGiA3 
_jC144 
2014^ 
301 4 5 
.0147 
; 

JOiSl 

j0152 


SUOpLuI^f fcULNATIISLL.CLLjAi 
UlMf NSlON iSEOt 3 ».t UL «-» *AI3« i» 
D I men: ION X»3,3*3»*rli#3l 
DO ICG K=l t 3 
00 1C I=i 
00 S 0-|t3 

1 = 7.0 ----- 

IF 1 1 *LC*J I DfT^*J,Kl -t 

CONTINUE 

IF < 1 S r< G I H J*LC • - 1 GO Tc K.-C 

-m- r*e-wn j 'F li * k ' 


IFIISEUIH I *EQ *2 I 
IF llSEUlH Je£q *3.» 
X'c ?,L ,H irCPSA 
x«.:I3*ki=-sina 
SINA 

413.: ikj=cqsa 
GO TO 100 
X-* 1 « 1 •*< 1 = COSA 
X < 1 , i ,K 1= SIN A 
^3iiJKL=-5JNt ... 
jcK j,i*Hl=CuSA 
A' Tu I'. 

XII , A »K)rCOSA 

X|.?*i*K» = SIN A 

X<L,2*K>=C0SA 


60 TO 22 
60 TO .3.; 


J 

I 


i 


.3153 


00155 
4CU3 
JC-16 1 
iCulfcH 
_G167 
0L17- 
,017 l 
J 017 S 

-0177 
-02:01 
30 2C 3 
.02*:.-* 
.02 rf. 
jy 2 rj 
1 TJ 12 
002 1 5 
0021 7 
2022 3 


EULER ANGLES TO THE TRANSFORMATION MATRIX 
(CONTINUED) 


2 *.* 

31 * 

2 ?* 
33 # 
54 v 

' .■# 

37 * 

3 4 # 
2 ®* 
H "** 

4 1 * 
4 ?# 


IOC 


4 # 
44 v 

4 *$* 

4 # o 
4 7 # 
4 «# 


30. 

4 -j; 


CONUNUf 
HO Mud 1 - 1*2 

*r 5-L - - 

M) 3L ~ 1= l.i 
00 3*. > Jr 1*3 
rr. wp-.-.f' 

3a Ts. ^l*' 

iHL.EC.l* H0L0 = XIH*J,31 

If I L. CO .2 1 HOtl>rii*K ,4 1 „ _ 

rrtAbstMaLDi.ti.i.JC-uii go jo 

IF IALS1XI *wE-IG 1 00 TO ^5 
TfMTr TC!*P ♦Xll Ut*-Hl ft ‘tOLy 
Cf'KT 1 i*U5 „ „ 

iriL.Evi.tl I *J1-Tt 

iriL.Eg.2l A l.I* J 1 rTt MP _ 

CONTINUE 

CONTINUE 

^CTUhN 

END 


f‘N r - 01 COMPILATION: 


NO PI ADN^ST ICS • 


BKSSS 



NAME: 


MATEUL 




PURPOSE : Extracts the Euler angles from the given trans- 

formation matrix and the required Euler 
rotational sequence. 

INPUT : ISEQ . Rotation sequence, (Integer Array (3), 

i.e., 1,2,3.) 

A - The.3-x 3 transformation 

OUTPUT : EUL •..The Euler angles. In "ISEQ" orderjARRAY{3). 

ALGORITHM REFERENCE : Appendix A; Euler angles as a function of the 

matrix elements, sequences (1) thru (12). 


I ■ 

B-5 


TRANSFORMATION MATRIX TO THE EULER ANGLES 


jFOR.lS f*ATEUL,MATEUL 

for saLi-ra/i9/.7 7**'?<»s? < **2t» i»* > 


PAGE IS 
0P POOR QUALITY 


SiJ~t-'Oi»TlNL KATkUL .. NT R ¥ POINT 

STORAGE USED: CODFUI HATA <v } ?r,jZS2 S **-**»* C0*MPIiC2l 

EXTCR-Mu ft EFE P E NCL S N.A«f 1 . 


:> SuRT 

V’j i, 4 A 1 AN 2 

y?jS M"RJ« 


ST^RACir ASSIGNMENT KLOIK, T¥rf, ^ELftTlVt LOCATION, H A M r I 


; '21 l^L 

' 'll ' - *U 1 •- 3'L 

: : „l * . •:: i . i 5H 

'Si P ‘-‘‘‘if* bSIGrt 

.-r, r -:rc ;3 ruu- 

r' JL T :v "‘■jv. V J 


;-:J 

i 


S-So 

1 3l 

: ::i 
-..21 
. : :-i 

** T • 7 

j * 1 

- ^ 

22.. 
25 ? 

4 L 
k L 

«. i‘. 

•* :**L7 

* *4 . 

. J 

CSIbil 


J^l 

L-fl'J 

JIG 

r 

jj 

JCU? I 

i o vj i 

">3330 

’G9J3 


. Jlol 

aoir .4 

3P1C5 

-OIL'S 

..GIL? 

JCI1’) 

;cn : 

-311 i 

;rm 
it 11 5 
.31 1 7 
J3121 
j-312? 
l.Ql ?4 
-Pl 2 t 
:C12 7 
,31'* 
:ni32 
0D13 3 
00135 
jP13fc 
jp* : 
. C 14 1 

'ci« r 

.2144 

JO 1 4 3 
in 1 ft t 


j'Jt 11 wf MA TFUL M SL « ,A ,»"UL ) 
iiytNSiON At3 ,2 1 *f ULl .i 1 
DIMENSION ISEOITI 
irlSLCll I 
jrist- Cl?l 

KtrSL0i31 ...... 

lFllZr'u,K» IE OK ~ h .9 b 

‘ SION- 

ircr^F^*! » to to in 


IFU 


GO TQ 


IFIJ.NE .i 1 GO TO « 

HSior*=-i," 

'in i» ck.o. * - 1 w - 

:>? To s * 

GSICS --1 . ' 

:fi ugk.nt ... i l - i 

Gl TO 3* 

IFtJ.NL.2j GO TO 15 

tsign=*i.; k , _ 

IftUOR.Uf .01 L - 3 

,O tu ' 3 * 

:5I0K"-I.. 

IT l I L H • m 5 * jl L-. 

o To 

IF1J.NL.3 1 go to ?g 

*SI0N- -1 • ' 



TRANSFORMATION MATRIX TO THE EULER ANGIES 
(CONTINUED) 


S8S8! 

ill? 
□0212 
□0213 
□021 <* 
□02 1 5 
..'C 216 
002 2 G 
00221 
C0222 
jQ 12 5 
G022H 


29* 

or* 

j l* 
12* 

3 3* 
3 ** 
35 * 
36 * 
37 * 
38 * 
J9* 
4T* 

4 1 * 
42* 
4 3 * 
44* 
45 * 
46 * 
47 * 
48* 

49* 
52* 
51 * 
52* 
53 * 
34 * 
55 * 
56 * 
5 " t * 
5P* 
59 * 
6 0 * 

fcZ* 
6 3 * 

b 4 * 
6 C * 
66 * 
t 7* 


IF 1 IL0K*F*E»C> L ~ i 
GO TO 30 
CSIGN--1 • C . 

IF l lt_OK.SE.Dl L-i 
jo u: N- U3 
FNS6K- 1*0 

IF ( ft.CO»Z > GO TO 70 
ir 4N*E«*1 > GO TO 5£ 

If tlC QK. HE. 01 GO TO Hj 
FNSGN=B5L6M . 

JJ^l 

r>C TC 46 

TF?fesWJf*GT*.3i&> ED50 n:-1 
fnuh-fh5g n*a t I » J » 

F DC N-FDSGN*At I*J4> 

IEQK?MC.a> GO TO 65 
fhsgn-bsigh 

II-K 

JJ-K 

GO TO 60 

FOSChrBSI&N 

II=L 

FNUM-FNS6N*Af J.K 1 
FOE K-F ^SG h*A 41 1 * JJ > 

IF t It OK* Ht *□ I GO TO 8 5 

FNUM-CSIGN*At I.K > 

EDEN-SOFT t i *0 -A t J *K l**t > 
(jO T 0 vC 

. FHUH=5QPT tl.O-A<I*I i**2> 

c5L?r.{*AtAN2IFNUK,rDENT 
, CONTINUE 
tlC TURN 
5 NO 


LNt OF COMPILATIONS 


NO DIAGNOSTICS 



NAME 



QMAT 

PURPOSE : Generates the transformation matrix from the given 

quaternion. 

INPUT : Q - The quaternion; ARRAY (4) . 

OUTPUT : A - The 3x3 transformation matrix 

ALGORITHM REFERENCE : Equation (15) from Section 2.2. 



IFOR, IS 0HAT,QkAT 

FOR S'*E3-02/19/77“06t2M ti9 l» J> 


S.TPR05JT1NL CiKAT fNTRY POINT O'*': 07 7 

STORAGE UbFD: COOF I It .*0C1 0$* HAT* t *. 5 -IC-jul*,; {*LaNK cOHMONt2» 
EXTErnAU rtfFf kCNClS liLOCK, NAHL » 


..0,3 NUikl.i 


ST ORAlif 

JOuO 
“ •»on- P 


ASSIGNMENT 

Cu r-o7 iNjrv 
"i. *T k 4 P6 


tfcLdCK, TfFE, «ELATlWr LOCAtlON, NAMTT 

• jl p 00 "3 F . P2 GODS p -Old: 

_ jun r oo :cro temp 


.cioi 
’01C 3 
3010** 
J0105 

.01 r 6 
iD 1C 7 
.‘Oil ) 

58 } 1 2 
0011 7 

0011 4 

4 u 

..0117 

m:r 

?3i!i 

0012 7 
0012* 

•Sill 

.0127 
jCir : 
,0131 
30132 


1* 

?* 

7* 

u* 

r >* 


A* 

7* 

8* 


K* 

11 * 

17*. 

l’* 

14* 

1?* 


I’* 

18* 

19* 

21* 


2 2* 
27 * 
24v 
25* 


l»i 


SUBROUTINE CmATU,A» 
DIMENSION 044>,A13,jT 
P 2 - 0 l 2 1*0 121 
ptrcin*w ‘ 
r *4 = i. l •* 1*4 
p"-P**wT<t * 

PC -T 4*014 » 

rr rip- 1 *o— P3*o 13 » 

Tl r,!»^L«P-86 
At2,2»=l ,^-P5-P0 
Ai:l3l=TE «P-P C ' 

PS = F2*0l 3 I 
PS=PV*orii 
A I 1 ,c J=P6-Pb 
U.M >=PL*Pb 

Pc r p^*Q|4 ) 

Rc^ri^oi i i 

At 1,3 >=:rs*Pt» 

P5=P3*Ut4> 

f’S-Pl *0t 1 ) 

A 12, -f’S-Pb 
1 1 3 , 2 I -F 5 *Pa 

7CTL*l.fi 

TNI) 


MO DIAGNOSTICS, 


END Of C 0 MP J l. ATI QN t_ . 




NAME: 


PURPOSE: 


INPUT : 

OUTPUT : 

ALGORITHM REFERENCE: 


MATQ 

Extracts the positive quaternion from the given 
transformation matrix. 

A - The 3 x 3 transformation matrix 
Q - The positive quaternion;ARRAY(4). 

See Reference 2. 
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•• TRANSFORrtftTTQH MATRIX TO THE QUATERNION 

Fo 8 R 5 nE 3 -r 2 /l 5 /^-*fc *^ 4t21 ** r> 


ORIGINAL PAGE 13 

OF POOR QUAUTX 


SU^kOuTlNt TO 


CN1KV POINT O'C'V'I 


_ ... jy ATX TA f *** J d|. ftUK I Z I 

StOR*r,f USETO: CODE 111 900*20; TJATAI. > — "Su. 9 

EXTERNAL ftFFEftFMCES IhLOCK, Nfc^EI 


^;.U Nt 7 ,'< 3 * 


» .t.iirfc TV PE. • RELATIVE LOCATION* nAMf> 
STORAGE ASSIGNMENT IHOCK* T*PL, tLAH L 

r,ci ^- !V 3 iri ?CSfSf l*l b "E*! 

-* ->*• * X > . 1 1 Ul I I 1 J— A t i M L. r ; D ^ 

xiy fcVv i:l* * j -••’• * • 


uOCJl 

jt"l ','^1 

, . ■* « Q ^ l 

■ m K w 


VJlCl 

.■Dies 

iClCM 

.-'QIC'S* 

JU 1 J ‘J 

..Dill 
-0 IK' 
jOii** 
jQilb 
jQI .2 J 
;01?l 
r i ? i 

•.'012 3 

..0124 

>oi: 5 
,,0126 
;oi2 1 
J&13 0 

;EH? 

: (j 1 3 3 
^ C i 3 N 
3913b 
3013? 

0C14T 

■ni “2 

-01“ '4 

'J145 
.,C14 7 

*’ i c ' 
- 

"9193 
.C19 4 

"•IS 'j 
•0157 


1'4 

?«■ 

< 4 * 

r ff 

f.* 

7* 

P# 

o* 

1 ?* 

n# 

i’o 

is* 

!*♦>? 

"IS* 

16 * 

17 # 

l‘l* 


SUBROUTINE HATCn*Q> 

JINEINSION A |3 , j > *C ( ♦ 1 » 1 l*« » 

r=:- 

HG-w*C 
•>0 4v. 

IFI J.Fu.* » CO TC -E 
IF I J*CQ *3 1 j*0 10 
IF t J.cc.4 1 GO TO 19 

- yr m ! f i I ? , : i ♦ in r ; 1 1 -vi ? , t > * i .0 

T ( J>- 

1 1 1 * 1»-A t.2 * ‘ t 3 ,3 » *1 *L 

Tl J »~A f 3* 2i”A * 31 

TEMPz—A j 1 .1 »*A|2.T1 “AIa,3 »*1.L 

ti *J r*AiSf*i. — — 

>. tfhS?-ai i *i»7;j 2 *?»** * >#3 M1#v 

UlTtMP.LT.Bllil GO. TO .y .. 
r UG-tTHb 
J- J 

ifiiJeo^^go TO fc'J 

tf rn^K.^T,,, /»u » * 

Tf *px„ .90 /Ull> 

JO Sw J-2*4 

Q«J*-tL*P*TUl 
r. CONTINUE 

Sj RETURN 
END 




i PmPILAT 10*48 


jl NJSl ICS- . 



PURPOSE: 


INPUT : 

OUTPUT : 

ALGORITHM REFERENCE : 
sequence (10), a 3, 2, 


Generates the quaternion directly from the yaw- 
pitch-roll Euler angles, i.e., a 3, 2, 1 Euler 
sequence. 

YPR - The yaw-pitch-roll Euler angles? ARRAY (3). 
QO - The positive quaternion, ARRAY (4). 

Appendix A, the quaternion equations for Euler 
1 sequence. 


NOTE: This subroutine calls "POSNOR" to take the normal of the positive 

quaternion. 


N 


i 



W-PITCH-ROLL EULER ANGLES TO THE QUATERNION 


Original £age is 

OE POOR QUALITY 


dfOR.S. YPRG.YPRQ 

FOR S0E3-02/iO/77-Q6:24 <»'» 

SUBROUTINE YPRQ ENTRY POINT 31C11* 

STORAGE USED: CQDEU1 nCOl'lS DATA tDl OOOUZaS rLaMK c0«H06H2» CU 
external references IULOCK, NANE» 


v.r±3 

30G<» 
JQC5 

3006 


PUSUOW 

cos 

SIN 

NEPR31 


storage assignment i^lock* type, relative location, name* 


tor R "'u ‘ J1 . CP 
■jnoa F ?w r 'JE4 Hr 
OOvQ.R l 1 Cl 2 12 SY 


u ‘JO R 00 "01 1 CR 

00 "U 1 6 iNjPfc 


JOG* 1 P 3J103T C 
■j„GO R *-3 0000 * 


301 Cl 
3010 3 
^31C4 
30 10 5 
.10106 
30107 
0U113 

30111 

30112 
.011 3 
3011*4 
10113 
,0116 
J0117 
>0120 
3012 1 
.3012? 
■0123 


1* 

2# 

7# 

4* 

5* 

6 * 

7* 

A* 

o* 

13* 

1!* 

i^* 

l?v 

14* 

is* 

16* 

17* 

13* 


SUS ROUTINE YPROIVPR.wOl 
PIMfNSION YPRI3 »*CIhI ,l044I 
HY= . 3.1*Y PR 1 1 1 
HPr 3 J*Y PR I 2 1 
HR = g. 5 j*YPR!5r 
CYrCOSIHY > 

CP=COStHP > 

CP-COSIHR > 

SV=SIN(HY1 

SPrsi NIMP » 

iRiSiNtHR > 

Cl 1 » =C Y*C P*CR *S Y*SP*SK 
Q( ? ) =C Y*C p*sr-sy#sp*cr 

Ql 3 > -C Y*S P*CR ♦SV*CP*SR 
Qt 4 ) = -CY* SPASR*SY*CP*CR 
CALL POSN ORIO »Q0 > 

RFTtJPN 

END 


END OF COMPILATION: 


NO DIAGNOSTICS, 


B-l 3 


\ 



1 

»- 


I 


PURPOSE: 


To output the positive and normalized quaternion 
from the given quaternion. 

INPUT : Q - The quaternion; ARRAY (4). 

OUTPUT: QO - The positive-normalized quaternion; 

ARRAY (4). 

ALGORITHM REFERENCE : 

1. If the sign of Q{1) is negative: 

Set Q0(I) = -Q ( I ) for 1=1,2, 3, 4. 

2. Set Q0(I) = Q0( D/TEMP 


where TEMP = VQO? + Q0| + QO* + QOj 





SELECTS THE POSITIVE QUATERNION AND NORMALIZES 

dFOR.IS POSNOR.POSNOR 

FOR S0E3-G2/19/7 7-06*2*2 14 I, i}» 

subroutine; posnor cntrv point o^orss 

smilir USED! C0DII1) C0DL6T; DAT*CCI GCuJLIs bLaUR C0WMOWI2I C 

. .EXTERNAL REFERENCES IflLOCK, NAME). . 

00D3 SuRT 

D0G4 Nt°R:s 

STORAGE ASSIGNMENT I BLOCK , _T* PE , PELAtlvL LOCATION, NAME! 

3301 r«noib me c iCL_ utuais 1 2 1 c> doco 1 3aaaa«; 

aotu ft.. 3iin.j: i ,..TEpp„„ ; : '... 


igi81 

1* 

SUflPG UTTN C POSNORtO,UO» 
DIMENSION QIAl.QOtAI 

2* 

egfg? 

3* 

A* 

TF?U1 |3lT".J^T TTMPr-i # 5 

D0107 

5* 

SUNr^ , t 

-0110 

?.* 

DO f.i 1=1*4 
301 I |=TEMP*Qt 1». 

jail 3 

?* 

ooii^ 

A* 

SUM =SUK*U Oil ) *00 1 1 ) 

mu 

** 

50 CONTINUE 

10* 

TEMP=1.0/ SQRTlSUH) 

polio 
001 ? 3 

11* 

17* 

no lco 1=1*4 

001 n=TrMP*oo m 

:oi2h 

IT* 

I'D CONTlNUf 

..0126 

14* 

><F TURN 

:.012 7 

15* 

END 


END Of 

COMPILATIONS NO DIAGNOSTICS 
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OF POOR QUALITY 


MASA-JSC 


